#!/usr/bin/env python3

import rospy
import DrEmpower as dr

id_num = 7 #关节电机ID号

def motor_control():
    # 初始化 ROS 节点
    rospy.init_node('motor_test_node', anonymous=True)


    '''单个绝对角度控制'''
    dr.set_angle(id_num=id_num, angle=-45, speed=5, param=10, mode=1)

if __name__ == '__main__':
    try:
        motor_control()
    except rospy.ROSInterruptException:
        rospy.logerr("ROS 中断异常")